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Abstract — This paper presents a novel Luenberger-style 
observer for robot manipulators with position measurements. 
Under the assumption that the state evolutions that are to be 
observed have bounded velocities, it is shown that the origin 
of the observation error dynamics is globally exponentially 
stable and that the corresponding convergence rate can be made 
arbitrarily high by increasing a gain of the observer. 

Comparisons and relations between the proposed observer 
and existing observers are discussed. 

The effectiveness of the result here presented is illustrated by 
a simulation of the observer for the Pendubot, an underactuated 
two-joint manipulator. 

I. INTRODUCTION 

Observers for nonlinear systems have been extensively 
studied in the last decades (for example, see [1] and [2]). 
In the specific case of robotic manipulators it has been of 
great interest to design observers that estimate velocities 
from position measurements. In fact, many commercially- 
available robotic manipulators are not equipped with velocity 
sensors; as a result, observers that estimate velocities from 
position measurements have been instrumental in designing 
feedback controllers that use only position measurements. 
The literature on this topic is vast; refer to [3] for a literature 
review. In some articles it is proved explicitly that, in certain 
conditions, the state of the observer that is used to do 
feedback from position measurements converges to the state 
of the robotic manipulator even when the observer is in open- 
loop. Examples of such articles are [4], [5], [6], [7], and 
[3]. In addition, [8] and [9] present observers for robotic 
manipulators without employing them in a position feedback 
loop. Moreover, rigid robotic systems are a subclass of Euler- 
Lagrange systems, and intrinsic observers for Euler-Lagrange 
systems with position measurements are proposed in [10] and 
[11]. 

This paper introduces a novel asymptotic observer for 
rigid robotic manipulators with position measurements. The 
proposed observer is Luenberger-style and is very simple in 
structure. Under the standard and realistic assumption that 
the state evolutions that are to be observed have bounded 
velocities with bounds known a priori, it is shown that 
the origin of the observation error dynamics is globally 
exponentially stable; in addition, it is demonstrated that the 
corresponding convergence rate can be made arbitrarily high 
by increasing a gain of the observer. 
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The observer here presented is compared with three similar 
existing observers for robotic manipulators, and it is shown 
that in several aspects the comparison is favorable to the 
proposed observer. 

The rest of the paper is organized as follows; in section UTI 
the observer is presented; section [Hi] discusses comparisons 
and relations between the proposed observer and some 
existing results; in section IIVI a simulation of the observer 
for the Pendubot is shown. 

In what follows || • || denotes the Eucledian norm of a 
vector or matrix; moreover, given v £ M n , Vi denotes its i-th 
component; R™ denotes the open interval (0 oo) n . 

II. MAIN RESULT 

The dynamic equation of a n-joint rigid robot can be 
expressed as 



M (q)q + C(q, q)q + Fq + g(q) = Hi 



(1) 



(see [12]). In Q, q £ R" is the vector of joint positions, 
u £ R m is the vector of control inputs, M (q) £ R" x ™ is the 
inertia matrix, C(q, q) is the Coriolis and centrifugal matrix, 
F is the diagonal matrix of viscous friction coefficients, g(q) 
is the gravity vector, and H is the input matrix that differs 
from the identity if the system is not fully actuated. M, C, 
and g are assumed to be continuously differentiable. 

Denote by Q C R n the set of all feasible values of q. 
Q is typically determined by the mechanic structure of the 
robot and/or by the way the robot operates. Note that if qi 
is the joint position of a prismatic joint, then qi ranges on a 
bounded set because for physical reasons the relative linear 
displacement of two links connected by a prismatic joint 
cannot grow indefinitely. However, if qi is the joint position 
of a revolute joint, then qi could range on an unbounded set 
since it can occur that the links connected by a revolute joint 
can rotate indefinitely with respect to each other. Thus, in the 
general case Q is unbounded. 

The following properties of are inherent to robot 
dynamics (see [13, p. 139]) and they will be useful in the 
sequel 

PI: det(M(g)) / Vq £ Q 
P2: HM-Vg-)!! < M Vq £ Q 



P3: Vi £ {l,...,rt}, the i-th element of the vector 
C(q,q)q is equal to q 1 Ni(q)q with 2Vj symmetric, continu- 
ously differentiable, and such that 3Ni > that satisfies 

\\N t (q)\\ <N % Vq£Q. 



It is assumed that the vector of joint positions q is 
measured, but the vector of joint velocities q is not measured; 
then, Q has the following state space representation 

q = v 

v = -M- 1 (q)(C(q,v)v + Fv + g(q)-Hu) (2) 

y = q 

This paper presents an observer for systems of the form 
(|2}; clearly, such observer is useful for estimating the joint 
velocities v. 

The state evolution of (|2) that we want to observe 
(q(i),v(t)) is assumed to be defined Vf > and with 
bounded joint velocities, that is there exist Vi > i = 
1 , . . . , n such that 



\vi(t)\ <Vi Vi > Vi G {!,..., n} 



and it is assumed that the Vi's are known a priori. 

This assumption is definitively realistic. In fact, it is 
reasonable to expect that the joint velocities of a robot 
will not exceed certain a priori bounds that come from 
the mechanic limitations of the robot and/or from the way 
the robot operates. Moreover, this assumption is recurrent 
in the literature on observers for robotic manipulators; for 
example, an equivalent assumption is made for proving the 
convergence of the observers presented in [3], [5], [6], [7], 
[9] and [11]. 

Denote by q and v the estimates of q and v respectively; 
then, the proposed Luenberger-style observer is defined by 
the following equations 

q = v — 9a(q — q) 

b = -M- 1 (q)(C(q,a v {v))a v (v)+Fv + g(q) (4) 
-Hu) - 9 2 f3(q - q) 

In © a, /3, and 9 are positive scalar design parameters, V — 
(Vi, . . . , V n ) is the vector of the velocities bounds, and cry is 
a component-wise saturation function with vector saturation 
level V; specifically, given Y £ R™ such that Yi > i = 
1, . . . , n, cry : R" -y R™ is defined as follows 



Xi if \x%\ < Yi 
{aY{x))i = { Yi if Xi>Yi 
-Yi if Xi < -Y, 



(5) 



i = 1, . . . ,n. 

Observer @ is obtained as follows. Make a copy of the 
system (|2ji to be observed; add innovation terms to that copy; 
saturate v in the Coriolis terms of the v equation. 

Note that the saturation level on each component of v 
is chosen so that if the initial states of system (|2ji and 
observer @ are identical, then observer @ tracks exactly 
system (|2j- In fact, if (q(t),v(t)) is a state evolution of 
(|3 corresponding to a certain input u(t), and it satisfies 
the bounds \vi(t)\ < Vi Vi > Vi 6 {l,...,n}, then 
(q(t),v(t)) is also the state evolution of the observer © 
corresponding to the same input and to the initial state 
(«(0),fi(0)) = («(()), «(0)). 



The insertion of the saturation cry in equations © was 
inspired by [14]. However, the observer presented in [14] 
applies to a class of systems that does not include systems 
of the type (|2jl. 

The following theorem states that observer l|4} is globally 
exponentially convergent with convergence rate arbitrarily 
fast. 

Theorem 6: Let (q(t),v(t)) be the state evolution of (|2jl 
corresponding to the input u(t). Assume that (q(t),v(t)) is 
defined \/t > and there exist Vi > i = 1, . . . , n such that 



\ Vi {t)\ <V Vt>0 Vi G {!,..., n} 



(7) 



(3) Then, V (a, /3, 7) G Rl 3 9* > such that if 6 > 6* the 



following property holds. 3k > such that the state evolution 
(q(t),v(t)) of © corresponding to the same input u(t) and 
to any initial state (q(0),v(0)) G R" X R™ is defined Vi > 
and satisfies 



v(t) - v(t) 



< k 



3(0) - q(0) 
v(Q)-v(0) 



e" 7 ' Vi > 



(8) 



Proof: To simplify the notation, let 
A(q,v) = C(q,v)v . 
Since Q holds, in the rest of the proof regard 

q = v 

v = -M- 1 (q)(A(q,a v (v))+Fv + g(q)-Hu) 

y = q 

(9) 

as the given system instead of (|2ji. 

Fix a > and f3 > 0, and assume that 9 > 0. Similarly 
to [1, p. 100] set 

m = iw) -«?(*)) cw = i(«(t) -«(*))■ 



Then, 



9G 



where 



and 



G = 





f(q(t),v(t),((t),6) 



-al I 

-(31 



(10) 



f(q,vX,9) = -M-\q) 



-(A( q ,a v (v + 9 2 ())-A(q,a v (v))) 



(11) 



Note that G is Hurwitz since a and (3 are positive. Let S be 
the solution of the Lyapunov equation G T S+SG = —I, and 
consider the candidate Lyapunov function for system dlOt 



s 



Then 



c 

+ 2[[S|| 



\\f(q(t),v(t)X,9)\\. (12) 



In order to find a proper upper bound for 
\\f(q(i),v(t),£,8)\\, proceed as follows. 
Using f|3]it follows that 

/ V T N 1 (q) 



dA, . 



V v T N n (q) 



Let 



(13) 



V = {«eR"| K|<Fi i = l,...,n}. 
Then, using F|3]it follows that 3_B > such that 

< B V(q,v) eQxV . 

Then, by [14, Lemma 2] 

\\A(q, a v (v + 2 Q) - A(q, a v {v))\\ < 2 B\\C\\ 
V(q,v,(,6) £ Q x R" x R™ x 1 

Since q(t) £ Q Vt > 0, letting L = M (B + \\F\\), from 
(EJ, <DE3, and 10 it follows that 



(14) 



(15) 



\\f(q(t),v(t),C,0)\\<L\\C\\<L 
Then, from ill 2> 



2||S||i) 



As a result, if 9 > 2\\S\\L, the equilibrium at the origin 
of system (II Oi is globally exponentially stable. Standard 
calculations (see [15, p. 154]) show that the rate of the 
decaying exponential that bounds from above || (£(f), CW) II 
is given by 

fl-2||S||£ 
2||5|| ' 

As a result, to guarantee that this rate is greater or equal than 
7, it suffices to take 



>6* =2||5||( 7 + L) 



(16) 



Remark 17: Even though the state of the observer con- 
verges to the state of the plant for any value of the initial 
state of the observer (q(0),v(0)), it is enough to consider 
values of (q(0),v(0)) with v(Q) £ V where V was defined 
in (II 31 : in fact, it is known a priori that the trajectory to 
be observed (q(t),v(t)) is such that v(t) £ V Vt > 0. 
Moreover, since q is measurable, it should be feasible to 
set q(0) w q(0); consequently, in practice it is enough to 
guarantee that the observer converges when (q(0),v(0)) € 
{(«(0),u(0))| ||g(0) - g(0)|| < e,«(0) £ V"} where e > 
is a parameter whose value depends on the accuracy of the 
position sensors. 



III. Comparisons and Relations with Existing 
Results 

The proposed observer is derived under assumptions 
equivalent to those for the observers in [5], [6], and [7] used 
in open-loop; moreover, those observers and the one here 
proposed present similar convergence properties. However, 
the observer here introduced compares favorably to those 
in [5], [6], and [7] because it is simpler in structure and 
consequently easier to implement. Indeed, the proposed ob- 
server is a plain Luenberger-style observer with a saturation 
on some of the v terms. Note that the observer in [7] has 
the advantage over the observer here proposed of being of 
reduced order; however, the structure of the former is quite 
complicated and, as pointed out in [16], the procedure to 
choose its parameters is quite complex. 

From a mathematical point of view, the observer here 
introduced compares favorably with those in [5] and [6]. 
In fact, in the proposed observer the error dynamics have 
the origin that is globally asymptotically stable; on the other 
hand, the origin of the error dynamics is only semiglobally 
stabilized in the case of the observers in [5] and [6]. 
However, taking into account the considerations in Remark 
1771 it follows that achieving global rather than semiglobal 
convergence might not be relevant from a practical point 
of view. An additional point in favor of the observer here 
presented with respect to observers in [5], [6], and [7], is 
that the proof of its convergence is simpler. 

The proposed observer is related to the nonlinear observer 
introduced in [17] as discussed in the rest of the section. 

The nonlinear observer presented in [17] applies to a 
certain class of multi-output nonlinear systems that includes 
systems of the form 



<7i 
fa 

('in 
Vl 



fi(u,q,vt) 
fl{u,q, vi,v 2 ) 

fn( u ,<l, V) 

fi(u,q,v) 



(18) 



in = fn(u,q,v) 



y = q 

where g,, Vi € R i = 1, . . . , n, u £ R m , and it is assumed 
that 

Al: u(t) £ U a compact subset of R m . 

A2: V(M) G {1,2} x {l,...,n} ft £ C 1 and /* 
is globally Lipschitz with respect to (q, v) uniformly with 
respect to u £ U. 

A3: 3 < a < (3 such that 



dfl, 



n ^ mn 



< a < Q, v) < (3 V(u, q,v) £U x R" x 

Vz £ {!,...,»}. 



Let a, f3, and 9 be scalars; then, in [17] the following 
Luenberger-style observer for system (1181 is proposed 



fa = fl(u,q,v{) -6a(q-q) 
fa = /l^W.^) - Oa(q - q) 

fa = fn( u ,q,v) -6a(q-q) (19) 
fii = f!(u,q,v)-e 2 0(q-Q) 

t>n = f 2 (u,q,v)-9 2 f3(q-q) . 

In [17] it is proved that, V (a, 0) £ R> 3 6>* > such that 
if 9 > 9* observer dl9l is globally exponentially convergent. 
An alternative observer for Jl 8i is given by 

fa = fi(u,q,v 1 )-9a(q-q) 
fa = f 2 (u,q, vi,v 2 ) ~ 9a(q - q) 




fa = fn{u,q,v) - 9a(q - q) 
fil = f 2 {u,q,v) - 9 2 (3(q- q) 



(20) 



Fig. 1. Sketch of the Pendubot. 



Vn = fl{u,q,v)-9 2 (i{q-q) 
It can be easily proved again that V (a, (3) G ] 



> 



such that if 9 > 9* observer (I20> is globally exponentially 
convergent. The advantage of J20t over dl9l > is that in order 
to prove convergence, assumption can be replaced by 
the following weaker assumption 

A4: V(fc, i) G {1, 2}x{l n}/fe C 1 and, denoting 

with Q C W 1 the set q ranges on, /* is globally Lipschitz 
with respect to v uniformly with respect to (q, u) G Q x U. 

Clearly, system (0 is of the type Jl 8i and it satisfies 
assumption however, in general, it does not satisfy 
assumption ^4] On the other hand, it is assumed for system 
(0 that the velocity v(t) of the state evolutions to be 
observed satisfy 0. Consequently, as said before, system 



q = v 

v = -M- 1 {q){C(q,a v {v))a v {v) + Fv + g(q) 
-Hu) 

y = q 

(21) 

can be regarded as the given system instead of 0. Note 
that the proposed observer (0 coincides with observer R2(M 
instanced for system \21\ . Convergence of @ can be justified 
as follows. From what stated before, it follows that if 

and ^4]hold for ( 12 li then convergence is achieved. Note 
that Mil satisfies ^3] and, as shown in the proof of Theorem 
|6j using properties 10 10 and [14, Lemma 2], it follows that 
\2\\ satisfies ^4] too. Moreover, note that assumption A[flis 
not needed to prove convergence because in equations (12 11 
u enters only through the additive term M^ 1 (q)Hu which 



does not depend on the unmeasured variable v; as a result, 
the dynamics of the observation error are independent of u. 

IV. Simulation of the Observer for the Pendubot 

The effectiveness of the proposed Luenberger-style ob- 
server is here illustrated by a simulation of the observer 
for the Pendubot, an underactuated two-joint manipulator 
moving in a vertical plane (see [18]). A sketch of the 
Pendubot is shown in Fig. ^ The first joint (shoulder) is 
actuated, whereas the second joint (elbow) is not. Both 
joints are equipped with position sensors (encoders), but no 
velocity sensors are present. Consequently, it is of interest 
to design an observer for the Pendubot that estimates the 
joint-velocities so that the observer could be included in a 
feedback controller that uses only position measurements. 

Define the joint variables qi and q 2 as shown Fig. ^ an d 
let u be the voltage input of the actuator. A dynamic model 
of the Pendubot can be found in [19] and is given by 
with q = (q x q 2 ) T , 



M(q) = ( ni+7r2 + 2?r 3 cos(q 2 ) 

\ 7T 2 + 7T 3 COs(q 2 } 



tt 2 + 7r 3 cos(g 2 ) 

7T2 



C{qA) 



-7r 3 sin(g 2 )<?2 
7r 3 sin(g 2 )<7i 



-7r 3 su\(q 2 )q 2 - 7r 3 sin(g 2 )gi 




9{fa) = f 
F v = 



77450 cos(qi) + ir 5 g D cos(qi + q 2 ) 
Tr 5 g Q cos(<7i +q 2 ) 








H = 



1 




where 



7T1 


= 0.0308 Vs 2 /rad 


7T 2 


= 0.0106 Vs 2 /rad 




= 0.0095 Vs 2 /rad 


7T 4 


= 0.2086 Vs 2 /m 


""5 


= 0.0630 Vs 2 /m 


.90 


= 9.81 m/s 2 . 



Assume that the Pendubot operates so that the angular 
velocities v = q do not exceed the following bounds 

|«i(t)| < 10 rad/s \v 2 (t)\ < 10 rad/s Vi > . 

The design parameters a and (3 of observer (0} are set as 
q = (3 — 1; then, referring to magnitudes introduced in the 
proof of Theorem |6] it follows that ||5|| = 1.81 and that L 
can be set equal to 54.01; consequently, the minimum value 
of the gain 9 that guarantees global exponential stability of 
the origin of the error dynamics is 9* = 195. Set 9 = 200 
so that the norm of the observation error will converge to 
globally, and it will be bounded by an exponential as in (|8j 
with 7 = 1.27. 

Choose the following initial state for the Pendubot 



/ 


<?? 


> \ 




( 


-tt/2 \ 

















"1 











V 


4 


J 




V 


o / 



which corresponds to the lower equilibrium, and apply the 
control u = 1.5sin(100i) that maintains the Pendubot in 
oscillation about the lower equilibrium. 

Taking into account that q is measured, choose for the 
observer the initial state 



/ 


<?? ^ 




( 


-TT/2 \ 





















2 


V 


«2° J 




{ 


2 / 



The corresponding state evolutions of the Pendubot and of 
the observer, plotted in Fig. |2] show that the observer is 
convergent. 

V. Conclusions 

In this paper a novel asymptotic Luenberger-style observer 
for robot systems with position measurements has been 
presented. The observer is very simple in structure; it has 
been proven that the dynamics of the observation error have 
a globally exponentially stable origin with convergence rate 
that can be made arbitrarily high by increasing a gain of the 
observer. 

The proposed observer compares favorably with some 
existing observers for robot manipulators derived under 
equivalent assumptions; its relation to a previous nonlinear 
observer has been discussed. 

A simulation of the proposed observer for the Pendubot 
has been included to illustrate its effectiveness. 




0.05 0.1 0.05 0.1 

t (s) t (s) 



Fig. 2. Simulation of the Pendubot and its observer. 



It will be topic of future research to investigate if this 
observer can lead to interesting results in the area of control 
of robot manipulators via position feedback . 
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